#!/bin/bash


sleep 30

# 加载 ROS 2 环境变量
source /opt/ros/humble/setup.bash

# 进入工作空间目录
WORKSPACE_DIR="/home/mas/masvision_infantry"
cd "$WORKSPACE_DIR"

# 构建工作空间
colcon build --symlink-install --parallel-workers 4

# 加载工作空间环境变量
source install/setup.bash

# 定义要执行的命令
cmds=(  "ros2 launch rm_bringup bringup.launch.py")

# 依次执行命令
for cmd in "${cmds[@]}"
do
    echo Current CMD : "$cmd"
    gnome-terminal -- bash -c "cd $(pwd);source install/setup.bash;$cmd;exec bash;"
    sleep 2
done    
